#include <Arduino.h>
#include "./device/screen.h"
#include "./device/camera.h"
#include "./device/haiman_driver.hpp"
#include "./logger.h"
#include "draw.h"
#include <esp_heap_caps.h>

void setup()
{
  Serial.begin(115200);
  screen_init();
  // sensor_power_on();
  // delay(200);
  // check_probe_i2c();
  camera_init();
  // sensor_init();
  // load_colormap(0);
  
  // 增加初始化时间并检查状态
  // for(int i=0; i<55; i++){
  //   sensor_loop();
  //   delay(5);
  // }
  // prob_status = PROB_READY;
  // flag_sensor_ok = true;
}

void loop()
{
  // 将相机图像实时显示到屏幕
  camera_loop();
  // 读取传感器数据并处理
  // sensor_loop();
  // screen_loop();
}